Modern Robotics, Chapter 10.7: Nonlinear Optimization